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FLEXIBLE MANIPULATOR ANALYSIS PROGRAM 


The Flexible Manipulator Analysis Program (FMAP) is a collection 
of FORTRAN coding to allow easy analysis of the flexible dynamics 
of mechanical arms. The user specifies the arm configuration and 
parameters and any or all of several frequency domain analyses 
to be preformed. In addition tine domain impulse response can 
be obtained by inverse Fourier transforming the frequency response. 
The purpose of the following description is to explain how to use 
FMAP. More detailed explanation of the mathematical and physical 
basis for the calculations can be found elsewhere II]. 

I. Modeling Concept 

The user specifies the arm configuration and parameters by 
choosing elements from those available (such as flexible beams, 
rigid masses, and controlled rotary joints) , specifying the para- 
meters of the element, and inputing that information via punched 
card in the sequence in which the elements occur on the arm. 

This gives the user the intuitive feel of building the arm out 
of the specified components. A complete list of available elements 
appears in the section below. Given the arm description a corres- 
ponding produce of transfer matrices is implied, one matrix 
for each of the elements specified. How this product is used 
depends on the analysis specified. 

The transfer matrix technique is a linear, frequency domain 
technique and as such is limited to small arm motions. In 
order to account for gross motions the arm characteristics must 
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be studied in several joint configurations. FMAP is constructed 
to consider only 4 by 4 transfer matrices and thus additional 
restrictions arise. Strictly speaking the 4 by 4 transfer 
matrices can only describe planar motion. In many arm config- 
urations the motions in perpendicular planes are uncoupled 
(for small motions) and thus two analyses of motion in the two 
perpendicular planes can be performed to describe the small motions 
of the arm more completely. Restrictions have been imposed on 
the combinations of elements that may be included in the arm 
model so as to avoid cases where the arm motion cannot be decoupled. 
These restrictions are included in the section "Arm Description." 

Using the description of the arm FMAP is capable of providing 
the user several types of information useful in evaluating the 
adequacy of the design in achieving the performance desired. 
Eigenvalues, frequency response, and impulse responses can be 
obtained. The parameters of these analyses are described in more 
detail under "Calculation Description." 

II. Arm Description 

The arm configuration is described by a series of cards 
describing the arm components and arranged in the order of their 
occurance on the arm. All inputs must be in consistent units. 

The following is a verbal description of the elements. All 
parameters are read by F10.0 Fortran format. 

Bernoulli Euler Beam — Type 1 

This beam model omits the effects of shear and beam cross 
section moment of inertia. The shear modulus of the material 
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should be provided however if there is included in the era configur- 
ation an element of type 8 (angle out of the plane of vibration) . 

Then it is required to evaluate the torsional compliance of the 
beau. The cross sectional shape assumed is a hollow circular 
cylinder, and other cross sections can be represented by using 
radii that will give an equivalent beam stiffness. The beam is 
assumed to have a complex modulus the imaginary part of which is ob- 
tained from the real part by multiplying by 0.01. This provides 
damping to the beam material. 

Field Parameter 

1 Element type = 1 

2 Beam length 

3 Shear modulus 

4 Young's modulus 

5 Mass density per unit length 

6 Outer radius 

7 Inner radius 

Timoshenko Beam Type 2 

This beam model includes the effects of shear and beam cross 
section moment of inertia and thus is more accurate at high 
frequencies and when the beam is not adequately slender to be modeled 
by the Bernoulli Euler model. In addition the imaginary part of the 
shear and Young's modulii can be specified as a fraction of the real part. 
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Field 

1 

2 

3 

4 

' 5 

6 

7 

8 


Parameter 
Element type * 2 
Beam length 
Shear modulus 
Young's modulus 
Mass density per unit length 
Outer radius 
Inner radius 

Imaginary part of elastic modulii 
as a fraction of the real part 


General Rigid Mass Type 3 

This con^wnent is specified in terms of the general inertial 
parameters. The mass is assumed to be symmetrical about the plane in which 
the motion is occuring so as not to produce twisting moments. 


Field Parameter 

1 Element type * 3 

2 Mass 

3 Mass moment of inertia about an axis 

perpendicular to the plane of 

motion and through the center of gravity 

4 Element length between the two 
stations of attachment 

5 Distance to the center of gravity 

from the point of attachment of the 
previous element. 
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Uniform Rigid Mass Type 4 

This rigid inertial field is specified in terms of the parameters 
of a or. i form mass. The parameters are as follows: 

Field Parameter 

1 Element type ■ 4 

2 Mass 

3 The square of the radius of gyration 

of the cross section about an axis 
perpendicular to the plane of motion 
and through the neutral axis. 

4 Total length 
Rotary Controlled Joint — Perpendicular Type 5 

This matrix describes the relationship between the torque M 

applied at a rotary pinned joint and the resulting angular deviation 

from the equilibrium configuration t|>. This is specified via a joint 

transfer function : 

ao + ajs a2S* + ... +a6S 6 M 

bo + bjs + 77 . + b,s' 

The axis of this joint is perpendicular to the neutral axis of the 
preceding element. 

Field Parameter 

1 Element type « 5 

2-8 ao through a6 

1-5 bo through bi, 

Rotary Controlled Joint — Coincident Type 6 

This matrix describes the relationship between the torque T applied 
at a rotary joint whose axis is coincident with the neutral axis of the 
preceding link and the deviation from the equilibrium configuration <J>. 


l 8t Card 


2 nd card 
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This relationship is given by the transfer function: 

at + ais ♦ ... + a$s* _ T 

G (s) - " 

b« + bis +.... + b^s** A<|( 


Field 

St 

1 Card 1 

2-8 

2 nd card 1-5 


Parameter 
Element type » 6 
ao through a& 
bo through b« 


Angle in Ana in Plane of Motion Type 7 

This element is an angle in the neutral axis of the arm which 
retains the axis in the plane of the motion being considered. The 
angle is a step change in the arm slope ty. This element is not to be 
used with elements of type 8 or other elements of type 7. When used 
with parallel elements outboard, these are assumed to be either type 1 
or 2. 

Field Parameter 

1 Element type = 7 

2 Angle in radians 
Angle in Arm out of Plane of Motion Type 8 

This element is an angle in the neutral axis of the arm which moves 
the axis out of the plane of motion of the preceding elements. The 
axis of the angle is in the plane of motion of the preceding link which 
experiences torsion under the motions. This element is not to be used 
with elements of type 7 or other elements of type 8. Parallel elements 
inboard are assumed to bi either type 1 or 2. 

Field Parameter 

1 Element type ■ 6 


2 


Angle in radians 



When this element is used IBC(u) and IBC(2) must not indicate the free 
condition. 

Parallel Elements Type 9 

This element combines the two following elements into a single 
parallel element by clamping them at each end. The neutral axis of each 
element is assumed to be coincident. The following two elements must 
be either type 1,2,3, or 4. 

Field Parameter 


1 


Element Type * 9 
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III. Calculation Description 

Several types of analyses are possible using FMAP, and the anal- 
ysis are described using a number of parameters . The parameters are 
input following the arm description in the following formut: 


card 

col. 

1 10 

20 

24 25 

29 30 

35 

40 

45 

50 

60 

70 

80 

var. 

name 

XLI 

V 

XRI 

J 

IBC(l) 

^ IBC(2) 

IBC(3) 
IBC (4) 

IPLQ 

NOMG 

IPR 

IPW 

) 

AEP 

V 

CINC 

CDEC 


Real 


Integer 


Rekl 


J 


Not all the parameters are required for each calculation, and for different 
calculations the parameters may have different meanings. The type of 
calculation is specified by the variable IPLQ which varies from 1 to 6. 

It is required in all descriptions. The 1 by 4 array IBC specifies the 
boundary conditions to be imposed on the arm in all cases where it is 
required. A brief description of the designation of the boundary condi- 
tions follows. 

Specification of Boundary Conditions . The vector IBC specifies the index 
of the state variables at each end of the arm which are required by simple 
boundary conditions to be zero. The following table indicates the 
permissible combinations of zero state variables. 


State Variable 


vuiooie 

Name 

Displacement 

Slope 

Moment 

Shear 

Index No. 

1 

2 

3 

4 

Boundary Condition 





Free 

+ 0 

* 0 

• 0 

- 0 

Clamped 

« 0 

- 0 

* 0 

ft 0 

Pinned 

• o 

r 1 o 

« 0 

* 0 

Sliding 

t 0 

■ 0 

f 0 

- 0 







9 


The values IBC(l) and IBC(2) are the indicies of the zero state varia- 
bles at the end of the arm corresponding to the first element para- 
meter cards and arbitrarily referred to as the left end. If that end 
of the arm is free, for example, the user will place a 3 in column 
24 and a 4 in column 25. IBC(3) and IBC(4) are the indicies of the 
zero state variables at the end of the arm corresponding to the last 
element parameter cards and referred to as the right end. The indicies 
at each end must always appear in ascending order. 

A. Natural Frequency Calculation — Frequency Sweep (IPLQ ■ 1) 

In order to calculate the natural frequency of a conservative 
arm system FMAP conducts a one dimensional numerical search to find a 
frequency at which the determinant of a 2 by 2 matrix is equal to 
zero. Numerical methods are necessary because this 2 by 2 matrix is 
generally a submatrix of a product of several 4 by 4 matrices and the 
frequency is involved in complex transcendental expressions which are 
impossible to solve analytically. In the frequency sweep mode FMAP 
evaluates the determinant at a number (* NOMG) of frequencies between 
the two frequency extremes ( XLI and XRI) and checks for a change 
in sign of the determinant. If this condition is detected a search 
algorithm is called which improves this estimate of the natural frequency. 
If the frequency steps were so coarse that an odd number (greater than 
one) of nature.- frequencies existed between them the search algorithm 
may return an error IER * 2 which is printed out, or it may converge to one 
of the natural frequencies. 


The input required is : 
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XLI ■ square of lowest frequency sweep 
XRI - square of highest frequency of sweep 
IBC * boundary condition specification 
IPLQ - 1 

NOHG ■ number of frequency steps in sweep 

IPW « power of 10 change in accuracy criterion from 10 5 . 

Data switch input: 

No. Condition Result 

0 dwn Print frequency squared and value of determinant 

at each step 
up Not printed 

1 dwn Allows review of results for possible additional 

calculation 
up No review 

2 dwn For extending sweep one decade higher in frequency 

up For extending sweep one decade lower in frequency 

3 dwn Perform extension indicated by switch 2. Preceded 

by a pause 
up No extension 

15 dwn Print frequency and transfer matrix at each modification 

up Do not print 

Printed output: 

1. Calculation description as input via card. 

2. Natural frequency squared and the natural frequencies in 
radians per second if a sign change in the determinant is found 

3. Error code IER 

IER « 0 successful search 

IER ■ 1 convergence to tolerance not achieved in 15 iterations 

IER -2 at some point in the search the value of the 

determinant had the same sign on both sides of the 
assumed root position. Should occur only if 
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the frequency sweep step is too large and more than 
one natural frequency exists between two steps. 

4, The transfer matrix for the system evaluated at the natural 
frequency. 

Plotted output: 

The values of the determinant D over the frequency sweep. Values 
of the determinant greater than 10 are plotted as 10 log^ Q ( | d| ) sgn(D) 
so that large values do not require scaling which obscures some zero 
crossings of the determinant. 

B. Natural Frequency Calculation — Direct Search (IPLQ ■ 2) 

In this mode FMAP proceeds directly to the search algorithm to 
improve the estimate of the natural frequency. Thus to insure proper 
operation exactly one natural frequency must exist between XLI and XRI. 
Card input: 

XLI ■ lower bound of estimate of root 
XRI “ upper bound of estimate of root 
IBC * boundary conditions specification 
IPLQ - 2 

IPW ■ Power of 10 change in error tolerance 
Switch input : 

No. Condition Result 

1 dwn Review results for possible improvement 

up No review 

2 dwn Preceded by a pause. Improve results by lowering 

the error tolerance if a root was found, if no 
root was found search between XRI and 2 XRI 
up Results acceptable 

15 dwn Print frequency and transfer matrix at each iteration 

of calculation 
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Printed output: 

As for IPLQ * 1. 

Plotted output: 

None* 

C . Calculation of the Time Im p ulse Response (IPLQ * 4) from the 
Frequency Response (IPLQ = 3) 

It is often desirable to visualize the time response of a system 
to give the designer a better feel for the capabilities of an am 
system. FMAP provides this capability by first computing the frequency 
response for the system forced with a sinusoiaa^ put at one of the 
boundary state variables at equal frequency intervals* This is 
equivalent to the Fourier transform of the response of the system to 
an impulse input at the forced boundary state variable. Thus by inverse 
transforming the frequency response we can in fact obtain the impulse 
response. 

The very efficient Fast Fourier Transform (FFT) algorithm is used 
to perform the inverse transformation. The precautions that must be taken 
to avoid distortion of the impulse response and to get all the sig- 
nificant information on the higher modes is discussed in [1] • In order 
to alleviate core storage problems the frequency response is stored on 
disk with direct access input/ output . (See section on direct access 
disk I/O) With larger core storage facillities this may be unnecessary . 
The transformation calculation is specified independently and requires 
separate input cards from the frequency response calculation, and 
utilises the values previously stored on the disk. 

Frequency Response — Linear Frequency Scale (IPLQ « 3) 
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Card Inputt 

XLI * lower end of the frequency range* This should be greater 
than zero (slightly) to avoid numerical problems 

XRI * high end of the frequency range* 

IBC « Boundary condition specification 

IPLQ - 3 

NOMG * number of points evaluated in the range XLI to XRI. NOMG 

must be less than or equal to 100 due to core storage limit- 
ations* Switch input at run time will allow one to calculate 
additional sets of NOMG samples of the frequency response 
in the range XRI to 2 X XRI if the arm system requires 
more points to obtain settling of the impulse response. 

IFR * Index of the forced variable, either IBC(l) or IBC (2) 

IPW - Number of samples stored on disk for this system from pre- 
vious calculations. IPW > 0 allows one to 
extend to higher frequencies data previously stored with 
the extension stored as a continuation of the previous data. 

Switch input: 

No. Condition Result 

0 dwn Gives printout of complex frequency response for all 

all four unspecified boundary variables 
up No printout of frequency response 

1 dwn Gives user option of extending results 

up No extension possible 

2 dwn Extends calculation to higher frequencies, with the 

same step interval, same number of steps 
up No extension 

4 dwn Include the first unspecified variable on the unforced 

side in plots 
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5 

6 
7 


dm Include the second unspecified variable on the unforced 
side in plots 

dim Include the first unspecified variable on the forced 
side in plots 

dwn Include the second unspecified variable on the forced 
side in plots 


15 dm Print out the transfer matrix and frequency on 
each alteration 


Output: 

The output of fundamental importance in this calculation is the 
disk output of the frequency response which is used as input to the FFT 
algorithm. In addition printout and plots of the same information is 
available on requests described by the switch input above. It should 
be noted that the frequency responses are for all four boundary 
state variables (at the ends of the arm) not specified by boundary 
conditions. These state variables are referred to in ascending order 

of their index , first on the unforced side, then on the forced side. 
Thus as input to the transformation subroutines of FMAP the user must 
refer to the response he wishes to inverse transform by a number from 
1 to 4. One refers to the first unspecified unforced variable on 
the forced end of the arm. For example if 
IBC(l) - 3 

IBC(2) ■ 4 « the forced variable (IFR ■ 4) 

IBC(3) - 1 
IBC ( 4 ) - 2 

then specifying the desired response as 3 one will obtain the response 
of the displacement of the free end of the arm to an impulse 

force loading at the same end. 
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Time aglie Response (IPLQ ■ 4) 

After frequency response samples have been calculated and stored 
on disk the user can use FMAP to inverse transform those samples to 
visualise the impulse response. 

Card input: 

IPLQ - 4 

NONS * Number of bits in the transform. It is required that a 
(NGNG • i \ 

total of 2 points have been computed and stored 

previously. With present dimension statements NONS $ 9 
IFR * The response desired. For the lowest indexed, unspecified 

variable on the unforced end IFR * 1. For the highest indexed 
unspecified variable on the forced end IFR « 4. 

Output: 

The output is the complex frequency response as modified for the 
FFT algorithm and the cooplex time response printed and plotted against 
time. If adequate sampling intervals of the frequency function have 
been chosen the last half of the tine response will be essentially 
zero to avoid distortion due to aliasing. The complex part of the time 
response should also equal zero for a properly computed transform. 
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C. Calculation of Frequency Response— Log Seal; (IPLQ * 5) 

Frequency response inf onset ion displayed in various foras is one 
of the sost valuable tools of the control engineer. FMAP provides 
a flexible tool for evaluating this information and displaying it as 
will be described below. Sinusoidal forcing functions are assisted 
applied at any of the boundary state variables at one end of the am. 
Since the forced variable is specified it aust be one of the variables 
included in IBC which specifies arm boundary conditions. The arm is 
assisted always to be forced at the end of the am represented by the 
first am element parameter cards. 

For conventional plots of response versus log frequency a frequency 
increment which is a constatn times the frequency is adequate. For 
polar plots this may lead to rather unintelligible and useless results , 
since large changes in the angle may occur over one or two iterations. 

To avoid this problem smoothness criteria are imposed which adjust the 
step size. 

2 

XLI ■ Beginning frequency of response 

XRI « Nominal maximum frequency 2 for the first NOMG response samples. 

2 

If the step siz* is varied the actual maximum frequency 
may be different from XRI. 

IBC ■ Boundary condition specifications 

IPLQ - 5 

NOMG ■ Number of frequencies on the initial pass. NOMG < 100. 

IFR “ Index of forcing variable which is either IBC(l) or IBC(2). 

IPW - Number of decades greater than 1 that extensions of the 
frequency are to include. 
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AEP ■ Haxiwai deviation between successive segments in a polar 

plot in radians before FMAP attempts to decrease the step size. 
CINC “ Maximum power to which the original step coefficient can 
be raised to give the maximum step coefficient. Equal to 
one for no increase. 

CDEC - Maximum divisor of the fractional power to which the original 
step can be raised to give the minimum step coefficient. 

Equal to one for no decrease. 

Switch input: 

No. Condition Result 

0 dwn Print complex values of the response of all un- 

specified boundary state variables 
up Don't print 

1 dwn Review results after first pass for possible exten- 

sion to higher or lower frequencies 
up No review 

2 dwn Extend results to higher frequencies 

up Do not extend results to higher frequencies 

3 dwn Extend results to lower frequencies 

up Do not extend results to lower frequencies 

These switches reference the four unspecified 

boundary variables in order of their computation 
and storage which is: lowest indexed variable, 
unforced end to highest indexed variable, forced 
end. They are querried in two instances following 
a pause and instructions to the user on the CRT. 
dwn Base smoothness criteria on this variable, 

up Do not use this variable 

dwn Include this variable in any plots made 

up Do not include this variable 

8 dwn Bode plot 

up No Bode plot 

9 dwn Polar plot 

up No polar plot 


4, 5,6, 7 


l* c tijfte 

2 nd ti.e 



18 


No. 

Condition 

Result 

10 

dwn 

Modified polar plot with vertical axis being 



the imaginary part of the response times the frequency. 


up 

No modified polar plot 

14 

dwn 

Print frequency and the ratio between it and the last 



frequency included in the plot. 


up 

Don't print 

15 

dwn 

Print frequency and the transfer matrix each time it 



is modified 

Output: 




The plots of the system frequency response indicated by the switch 
selection are provided for each pass of NOMG frequencies. The complex 
values of the response of all four nspecified boundary variables are 
printed if switch 0 is placed down. 

D. Calculation of Complex Roots (IPLQ ■ 6) 

For nonconservative arm systems, which includes controlled arms 
with velocity feedback or other form of damping, natural frequency is 
a complex number and usually referred to as an eigenvalue. (A con- 
servative system has an eigenvalue with zero real part.) In order 
to find the real and imaginary parts of this eigenvalue a search over 
two dimensions must be conducted to find the complex frequency which 
allows the frequency functior to equal zero. The frequency function 
is a complex function itself and in order to use conventional search 
routines it is necessary to minimize the modulus of the frequency function. 
The search routine may then yield local uiinimums of the frequency 
function not equal to zero which are not actually eigenvalues of the 
system. The minimum to which the search routine converges depends mainly 
on the point at which the search is initiated. Thus FMAP allows 
for the user to vary the starting position at run time depending on the 
observed results of previous searches. As developed this input is via 
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• keyboard and associated CRT display. Graphic display of the cosqplex 
plane and associated eigenvalues has been found to be very valuable* 
but is not included in the FMAP package because of large core require** 
nents and the fact that the graphics routines are very Machine specific. 
Input: 

The input is designed to allow multiple points for initializing 
the search to be input via' card, followed by an oppurtunity to input 
via keyboard an indefinite number of additional starting points. 

By the usual format: 

IBC ■ Boundary condition specification 
IFLQ - 6 

Additional cards are formatted as follow: 

One card with format 110 : 

HSR » Number of cards with starting points which follow 
Additional cards, NSR of them, formatted 2F10.0, 2110, 2F10.0 
DSL ■ Starting step size for search 
DL1H ■ Smallest step size allowable 
ITLIM * Maximum number of steps 

IPT ■ 1 for detail printing of each search consideration, « 0 for 
normal printing. 

X(l) * Real value of search starting point 
X(2) • imaginary value of search starting point 
Switch input: 


No. 

Condition 

Result 

12 

dwn 

Stop the search and accept a new starting position 


up 

Continue the search 

13 

dwn 

Print as well as display on the CRT the steps in the 
search 


up 

CRT display of the steps only 

15 

dwn 

Print transfer matrix each time it is changed. 
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Keyboard Input: 

Upon the display on the CRT of "STARTING VALUES, I ALT", key in the 
new values of X(l), X(2) and I Alt where 

IALT < 0 No new starting values to be input for this calculation 
IALT » 0 Accept the values of X preceding as starting points for 
the search 

IALT > 0 Accept additionally new values for DEL,DLIM,ITLIM, and IPT 
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IV. Exaggle Calculations 

In order to demonstrate FMAP results a very simple example will 

be included. It will be based on a beam whose first cantilevered natural 

frequency is 1.0. TO this will be appended a simple position and velocity 

feedback control for some of the demonstrations. 

The cantilevered frequency of a uniform beam is given analytically as 

(IV-1) Ui ■ 3.52 / El /(ui , > rad/sec 

where E ■ Young's modulus 

I ■ Cross section moment of inertia « it (r H - r* )/4 

2 i 

W ■ Mass density per unit length 

1 ■ Beam length 

r » Outer radius of the beam 
2 

r ■ Inner radius of the beam 

i 

8 

For B ■ 10 , r ■ 0.1, r “ 0.0, A ■ 10, y • 9.731, Equation IV- ) will 

2 l 

yield o> • 1.0. All units are assumed to be consistent SI units, 
l 

The beam alone is used for displaying options 1 and 2 for finding the 
natural frequency. 

If the beam above were essentially rigid a position and velocity 

feedback at a rotary joint would produce an eigenvalue with magnitude 

b> and damping ( where 
8 

u - /Sc/TyP) 

8 

c - /3c/ (2w i 4 ) 

8 

where k * position feedback gain 

c “ velocity feedback gain 

For k ■ 810.92, c ■ 2293.27 the above yields “ 0.5, C “ 0.7. These 
parasieter values were used in displaying the options 3 through 6, i.e. 
impulse response, frequency response, and complex eigenvalues. 
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natural Frequencies (IPIO ■ 1,2) 

Searching for o> Cor the cantilevered bean between 0.1 and 10 
and plotting the determinant (IPLQ - 1) and then performing a simple 
search (IPLQ » 2) is accomplished with the following input cards: 



lltllllllltItlSIttlOlOttlltOOOOOCOOOOOOOOODOOOOOOOOOOOOOOOSOnOHtllOOOOtlOOOOCOO 

1 1 1 * S • f I 9 mi iinnni%ni*ViU 

nmniMimuimmiiimmimmiiiimiiimn immmmmii imiii 


Printer output is as displayed in Figure IV- 1 with the plot of the 
determinant in Figure IV-2. It includes the frequencies and the system 
transfer matrix evaluated at that frequency. 

Impulse Response (I PIQ ° 3,4) 

The beam and joint described above are input and the frequency 
response at uniform intervals is calculated (IFI£ « 3) . the values which 
were stored on disk are then read back and the impulse response calculated. 
(IPLQ * 4) This is acconplished with the following input: 
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- u 1 J w ' 

)F IGIN.'VL P AGt) iS POOK 



Ml IIIOOII 8 0 0 0 0 0 0 OOOJOOOOPOO OOOOCOOOOOOCO 0 0 0 0 0 0 0 0 ^ 0 0 0 0 0 0 OOOOOPCOOUO 0 0 0 0 0 0 COO 0 CO 

i 1 1 4 1 1 r 1 1 Nil i! u i< ii IK u ii unit nuunnv nnx y n a? 34 n h 3m» :i n <i 4M)««*4(iHi43^'»n?s?s4HBfiSMi»u(itttn4t$KUMt)rcn nnunnu nnm 

111111 m ,11 1 1 1 mi 1 1 11 11 1 11 1 m m 11 1 1 1 11 m 1 in n n 1 m 1 1 m n 1 11 1 m 11 1 m m 11 


Three passes with 100 samples calculated per pass were used (controlled 
by data switch input) to calculate cPe 256 points used in tht transform, 
the printer output is not shown but Figures IV-3, IV- 4, and IV-5 
shows the complex frequency response calculated by the fire 1 : pass, the 
512 points of the frequency response as arranged for transformation via 
the FIT algorithm, and the impulse response, respectively. 

Frequency Response (IPLQ ■ 5) 

fhe seme beam and joint were input and used for calculation of the 
frequency response and its display as a Bode plot (Figures IV- 6 and IV-7) 
fend polar plot (Figure IV- 8) . A variable step size was used to attain 
a smooth polar plot. Printer output is not included. The required 
data cards are: 
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Coaolex Eigenvalues (IP1Q ■ 6) 

One* again the save bean and joint were input and a search for the 
eigenvalues was conducted. The first starting point was input by cards 
and the reaainder via keyboard . Notice that one attempt did not 
adequately converge in the 30 iterations allowed and was restarted. 

A totil of three distinct roots are found and displayed in Figure IV-9. 
The required card input was as follows: 


/T7 

/T7 


Tor 






0 . 1 


1 0. 


. 4tb 


i . to 


4-» 

1 • ccrOt «r >* 

3 T 

1 


first card 

1 1 111 H i II D 0 J f 0 i 0 0 0 0 0 0 0 0 0 0 0 0 0 J 0 0 0 0 0 0 0 0 0 C 0 0 D 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 

I t 1 < I I I I •HttUUMISIIIMIItNr :>»:<»H»N»M31U)]Mn)l)MIMW4l«243<4 4S<i4l<«nMS’ S: S) S4 S< ss SI SI K Mil CUM till « ua k nnittiltnni iw 

m 1 1 1 1 1 1 7 m m 1 1 m 1 1 m 1 1 1 1 m 1 1 1 1 1 1 1 1 1 ; 1 1 1 1 1 1 1 1 1 1 1 n 1 1 1 1 1 1 1 1 1 1 1 1 ■ i ii ii 1 1 1 1 1 1 
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Figure IV- 1 . Printed output for natux&l frequency searches: iplq ■ 1,2 
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Figure IV-3. Complex frequency reeponee of endpoint deflection to end point force. First 100 
samples: XPLQ ■ 3. 
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Figure IV- 4. Complex frequency response as arranged for inverse transformation via FFT algorithm 
Total ot 512 samples. 








rigur* IV-9. Results of eigenvalue search : 1PLQ - 6. 
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V. impleme nf tion Consideration! 

A. Hardware for Develop— nt 

The development of FMAP was performed mainly on the Interdata 
Model 70 minicomputer as configured at the M.I.T. joint Civil — Mechanical 
Engineering Computer Center. The 40 K bytes (4 bits) of core storage 
that was available was inadequate for storing the entire package at once, 
but adequate parts could be grouped together to perform the desired analy- 
sis. The program as listed in this documentation is the complete 
package, however, arranged to be compiled and run as a complete unit. 

The code is written in FORTRAN and compiled on a FORTRAN IV compiler. 

B. Run Time Inpht 
Data Switch Input 

Data switch input at run time is provided for to allow interactive 
analysis of the arm system. A total of 16 switches, numbered 0 
through 15 are assisted available. As implemented the down position 
corresponds to a value of 1 returned in the second list variable, and 
the up position corresponds to a value of 2. The first list variable 
of the "CALL DATSW" statement references the switch number. 

Converting FMAP to a machine without run time input capabilities 
will require the removal of these interactive inputs and thus some mod- 
ification of the program. 

Keyboard Input, CRT Output 

I/O was performed at run time on logical device 6 which was a 
keyboard for input and a CRT screen for output. 
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C. Graphic Output 

Graphic output is used extensively in *MAP. In all cases the 
nwerical data is assembled into an array and is then plotted by the 
graphics routine PICTR. This routine is specific to the system con- 
figuration on which the program was developed and is not considered 
to be part of the FMAP package. To convert FMAP to another machine the 
graphic output would have to be adapted to another routine. A portion 
of the PICTR documentation is included here to facilitate any such 
conversion. [2] 


* USER Scaled Plots. 


PICTR will automatically scale the plot if desired (see AESTH for description) . 
However, when several variables are to be plotted on the same frame, for instance, 
the user may wish to specify the scale to be used. The four element real array 
XSCL is provided to allow the user to set the minimum and maximum values on the 
plot. When the user provides these values, they are rounded to aesthetically 
pleasing values, as when the subroutine finds the minimum and maximum values. Any 
points which do not fit within these values will be Ignored when the plotting is 
done. (PICTR will not go off scale on the plotter.) 


"The elements of XSCL are XSCL(l) 

XSCL (2) 
XSCL (3) 
XSCL(A) 


minimum X value 
maximum X value 
minimum Y value 
maximum Y value 


"The use of the XSCL array Is controlled by the parameter XSCL. ISCL is 1 if 
PICTR is to scale the array, and nothing fancy intended. 


ISCL 


-2 Use data in XSCL to set scale for plot. 

-1 Use the same scale as was used for previous plot. 

4-1 Autoscale. 

+2 Autoscale, return minimum and maximum values in XSCL. 


" ISCL may also be used to specify semi-log or log-log plots instead of linear 
plots. When a log scale is specified on either axis, an Integral number of decades 
are drawn with ten tick marks per decade. Note that zero values can not be plotted 
but cause the autoscale routine to begin with the decade 10E-39, which will usually 
mean that too many are used. Use of a log scale on the x-axis is specified by 
adding 10 to the value of ISCL ab^ve. Use of a log scale on the y-axis is speci- 
fied by adding 20 to ISCL. The following table gives these values for all combi- 
nations. 
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-2, 

8. 

18, 

28 

Use values in XSCL to set scale for plot. 

-1. 

9. 

19, 

29 

Use same scale es wee used for previous plot. XSCL is 
not required. 

♦1. 

11. 

21. 

31 

Autoscale. XSCL la not necessary. 

+2, 

12, 

22, 

32 

Autoscale, return minimum end maximum values in XSCL. 


^log x vs. log y 
— - > x vs. log y 
— ^ log x vs . y 
— } x vs . y 

CALL PICTR(A,ZA,XLAB t XSCL7NVARS ,NPTS, NX, MCVE," LABEL , ZSCL , FTIME .LOOK) 

A is Che name of Che Cwo dimensional array in which the daca is scored. 

The first subscript is the curve number, Che second subscript is the 
point number along that curve. 

IA is the number of rows in the array, as specified in the DIMENSION state- 

ment. 

* 

XLAfi is the name of a twenty element real array containing labels for the x- 

and y-axes in A4 format. The first ten words (forty characters) contain 
the X label for the x-axis, the remaining ten words contain the y-axls 
label. (The easiest way to label the axis is to read XLAB from a card 
in 2QA4 format. PICTR does not center the label.) 

This la not required unless LABEL* 4. 

XSCL is used only if the user wishes to specify the scales to be used for the 

plot. It is not necessary when autcscaling feature is used. See User 
Scaled plots 

NVARS is the number of rows in the A array which are to be used for plotting. 

These rows must oe the first NVARS rows of the array. If one of the rows 
is to be used as the independent variable* it must be counted in NVARS. 
Note: N v 4 NVARS * IA. 

NPTS is the number of points to be plotted in each curve. This may be less 

than or equal to the second dimension in the DIMENSION statement. 

NX is row number of the curve to be used as the x~axis. 

If NX is zero, the data will be plotted at equal Intervals along the 
x-axls, ranging from 0.0 to FTIME* inclusive. 

If NX is positive, the remaining curves will be plotted as functions of 
the NX row of the array. NX must be less than or equal to '’VARS. 

MOVE If MOVE is zero, the pen will be left below and to the left of the graph 

after plotting. The next CALL PICTR will plot in the same frame 
if its own "MOVE" is 0 or 1. 

If MOVE is +1, the pen will be moved to the right of the graph that was 
Just drawn. The next CALL PICTR will plot in a new frame. 

If MOVE is -1, the pen will be move one frame to the right before the 
graph is drawn. 

(NOTE: when several plots are to be drawn in the same frame, it is best 
to draw only one box to save time and overprinting. Therefore, set 
LABEL*0 for all but one of the plots.] 

* . 

[Nete that tn* gri'* marks on the axes are automatically numbered by PICTR. 

XLAB is used to name tue parameters and variable plotted.] 
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LABEL 


ISCL 

FTIME 


LOOK 


Is an Integer from 0 to 4 indicating tha degree of sophistication 
desired in annotate.*. 

0 ■ no frame is drawn (used primarily if drawing In a frame used on a 

previous call to PICTR.) 

1 ■ simple box with maxlmue and minimus values written below the lower 

left corner. 

2 ■ simple box with numbers beside the tick marks on the bottom and 

left sides. 

3 ■ same as '2', but in addition PiCTR will read a single data card and 

use the first 40 columns to label the x-axis and the last 40 columns 

to label the y-axis. 

4 ■ same as '2', but in addition PICTR will use the characters stored in 

XLAB to label the x- and y -axes . 

specifies how the graph is to be scaled. ISCL should be set equal to 1 
if PICTR is to scale the plot ("autoscaling"). See User Scaled Plots . 

is the value to be used for the maximum x value if the points on the 
curves are to be equally spaced along the x-axis . (l.e.: NX * 0 ) 

The minimum value tor x is zero. FTIME should be a positive real number. 

If LOOK is zero, the plot will be drawn on the plotter and on the scope. 

If LOOK is positive, the plot will be drawn only on the scope. 

If LOOK is negative, the plot will be printed on the IBM 1403 line printer.'' 


D. Direct Access Disk I/O 

In order to alleviate core storage problems seme intermediate 
results are written in a disk file for later use by FKAP . In particular 
the subroutines TIMP and TRAMS coosnunicate via a disk file with the 
identifier 1. If adequate core storage is available it may be desirable 
to avoid this step. Since the disk setup and write procedure are 
machine specific the user will have to consider his specific system when 
he impliments FMAP . 
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VI. Modeling Exercise — Rancho Anthropomorphic Manipulator 

Hie Rancho Anthropomorphic Manipulator (RAM) is an electrically 
petered seven degree of freedom manipulator built for the Marshall 
Space Flight Center by Rancho Los Amigos Hospital under contract 
NAS8-28361. Part of the work proposed in the present contract involved 
construction of a mathematical model of this manipulator using the 
transfer matrix technique. Figure VI-1 is an assembly drawing of the 
arm in the fully extended position showing dimensions of the arm, 
weights of the arm segments and the model elements used to represent 
the arm. The modeling was based on data obtained from the arm drawings, 
a report supplied by the builders of the arm, and on information 
supplied by the component manufacturers. Thus with the exception of the 
segment masses which were measured from the completed arm, the modeling 
could have preceded the building of the arm. 

A. Modeling Procedure 

From the arm drawings the cross sectional area and area moment 
of inertia of the structural members of the arm were calculated. 

Based on the density of the material, mass appropriate to each structural 
member was calculated and subtracted from the given segment mass to 
obtain the lumped masses of the actuators and drives. 

The joints cl the RAM are intended to be self locking so they 
cannot be back driven. This lowers power consumption but prevents 
the joints from absorbing the vibrational energy. The compliance at 
the joints will only be that of the speed reducer, and effectively 
the compliance of only the last stage of the reduction. For the three 
joints with axes perpendicular to the axis of the arm extended the 
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final drive was a harmonic drive. Manufactured data was available for 
the ccsqpliance of the shoulder and elbow harmonic drive, but not for 
the wrist. Thus for this exercise it was decided to model the arm with 
the forearm supinator joint rotated to ; 'ace the axis of the wrist 
joint in the plane ef motion and thus eliminate it from consideration. 

The values for the various parameters of the arm model are listed 
in Table VI-1. 

B. Simplifying Assumptions 

Several simplifying assumptions have been made as in any model 
of a complex system. Some of these assumptions would be unnecessary 
with more information and with a slightly more complex model. 

The most severe and most easily removed assumption is probably 
the assumption of rigid bearings. Manufacturers give compliance for 
some bearings but this information was not available. The three 
rotary actuators par* 'lei to the arm axis and the wrist actuator 
would all be modeled with appropriate compliances. 

The structural members are assumed to be symmetrical with their 
neutral axes intersecting at the joints. The RAM has small offsets 
in some of these members , resulting in torsion as well as flexure. 

The flexural modes of vibration are not strongly coupled to the torsional 
modes for these offsets and this simplification should not severely 
restrict the results. 

Only the arm proper was modeled, ignoring the compliance of the 
arm support. Corresponding experimental data would have to approximate 
this end condition, i.e. fix the arm shoulder rigidly to ground. 

In obtaining the inertias of the various lumped masses uniform, 
slender geometry was assumed. The effect of this simplification is 
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Table VI-1. RAM aodal element parameters. 

10 2 

Beam Element Parameters (Young's modulus ■ 6.9 x 10 N/m ) 


Index 

Length 

(m) 

Density per 
Unit Length 
(kg/m) 

Equivalent Outer 
Radius (ra) 

Equivalent Inner 
P-adius (m) 

1 

0.1600 

1.3165 

0.0254 

0.0222 

4 

0.2507 

1.U93 

0.0140 

0.0115 

6 

0.1062 

1.3165 

0.0254 

0.0222 

9 

0.1397 

1.1393 

0.0140 

0.0115 

11 

0.0775 

0.3428 

0.009525 

0.007163 

Rigid 

Mass Element Parameters (ail assumed slender and uniform) 

Index 

Length 

(*) 

Mass 

(kg) 



2 

0.0432 

3.01 



5 

0.1207 

4.86 



7 

0.0432 

2.64 



10 

0.0508 

2.17 



12 

0.2540 

1.41 



Compliance Elaatent 

Parameters 

(control with only position feedback) 


Index Spring Constant 
(N^rad) 

3 1.469 x 10* 

1.469 x 10 4 


7 



probably negligible . 

C. besults Obtained 

If the in joints cannot be backdriven it is not possible to control 
the flexible vibrations of the am with sinple servo control. These 
flexible notions will be very lightly daaped, although hopefully snail 
in nagnitude. The frequency response of the am with no dsnping w* 11 
display the natural frequencies as resonance peaks , and the valu .s will 
be accurate except at the resonances which will be attenuated by the 
intrinsic structural danping. 

For this exercise it was chosen to calculate the am frequency 
response due to a unit amplitude sinusoidal force on the am end point. 
Figure VI-2 displays the nagnitude and phase of the end point due 
to that force. The first three resonances are visible, the first of 
which is 33.5 rad/sec (5.34 hz.). 
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